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Abstract 

We present a disturbance rejection mechanism for the for- 
mation flying of multiple spacecraft based on a robust con- 
trol approach in terms of an H «, control problem. The 
corresponding Hoo control problem is then solved numer- 
ically using linear matrix inequalities. 

1 Introduction 

Formation flying (FF) has been identified as an enabling 
technology for many of the NASA’s 21 s ^ century missions, 
among them, the Deep Space 3 and the'Terrestrial Planet 
Finder. Formation flying involves flying a group of space- 
craft in a particular pattern while maintaining precise (but 
often time varying) relative position, velocity, attitude, 
and angular velocity, with respect to each other [2], [6], 
Since traditional spacecraft control is often concerned with 
measuring and maintaining the same quantities for a sin- 
gle spacecraft with respect to an inertial reference frame, 
the analogous FF control and estimation problems are of- 
ten an order of magnitude more challenging than those 
encountered traditionally for a single spacecraft. In or- 
der to make the FF control problems at least similar to 
the single spacecraft case, an approach based on leader- 
following has been proposed by Wang and Hadaegh [7] 
(also refer to [8]). The basic idea in leader-following (LF) 
is to designate a particular frame (or multiple frames) in 
the FF as the reference frame(s) and measure and con- 
trol the states of the rest of the formation with respect to 
them. 

The present paper addresses the problem of designing a 
control law for the follo wer spacecraft in an LF formation 
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which is guaranteed to attenuate the effects of environ- 
mental disturbances on the performance of the leader fol- 
lowing. The results of the paper are in direct relevance to 
those reported [4] and [7] for the formation keeping prob- 
lem. Building on the basic feedback linearization scheme 
in [7], we propose a control mechanism for the formation 
in the presence of disturbance forces and torques based on 
the Hcc methodology. The linear matrix inequality (LMI) 
[1] formulation of the corresponding problem is then 
used to design a candidate controller which is, in the 
sense, optimal. 

The organization of the paper is as follows. In §2 the 
assumptions which constitute the framework for the for- 
mation keeping problem are listed. In §3 and §4 the basic 
facts and the formulation of the problem considered in the 
paper are presented, followed by the design techniques 
which introduce the formulation of the disturbance 
rejection. A numerical example and the corresponding 
simulation result are then presented in §5. 

First a few words on the notation. Formation flying con- 
sists of flying a group of spacecraft in a particular pattern. 
To be able to express the time evolution of the formation 
and design the corresponding control laws, it is convenient 
that a reference frame is attached to each spacecraft. We 
shall always assume that these reference frames are in- 
duced from a dextral set of three orthonormal vectors. 
Let the formation have n spacecraft labeled as 1, 2, . . . , n. 
Let P denote the reference frame attached to the i-th 
spacecraft; P on the other hand shall designate the iner- 
tial reference frame. For the inertia and the mass of the 
i-th spacecraft we use /* and m 1 , respectively. The force 
and torque acting upon i are denoted by f { and r 1 ; for 

the mass normalized force we used u* := -Lr- The time 
, m l 

derivative with respect to P shall be denoted by -4~- iike- 

j dt\ 

wise, -ft will be used for the time derivative with respect 
to P . denotes the position of the origin of P with 

respect to P ; r { is the position of the origin of P with 
respect to P . The desired position of the origin of P 



Figure 1: Formation Coordinates 


with respect to P shall be denoted by rj , and by r* 
when j = I. The velocity of the origin of with respect 
to P , the velocity of the origin of P with respect to P , 
the desired velocity of the origin of P with respect to P 
, and the desired velocity of the origin of P with respect 
to F , shall be denoted by , v l , , and ti ^ , respec- 

tively. Similar notation is used for the angular velocity of 
P with respect to P : is the angular velocity of P 

with respect to P and u^ is the desired angular velocity 
of P with respect to P (refer to Figure 1). The cross 
product matrix induced by the vector x = [x, x 2 x 3 ] T is 
the matrix, 


[*]:= 


0 -x 3 x 2 

*3 0 -Xi 

~x 2 n 0 


2 Assumptions 

We consider a group of spacecraft which are to be kept 
in a particular formation pattern. The attitude control 
of the spacecraft in particular is not considered in the 
present study. However, the orientation of the spacecraft 
does play a role in the formation keeping problem, since 
the angular velocity of the spacecraft effects the measure- 
ments of relative distances and velocities. The following 
assumptions are explicitly made in the present paper: 

1. One spacecraft is designated as the leader in the for- 
mation; the rest are referred to as the followers. 

2. The leader chooses its control force (to acquire the 
desired position, etc.) independent of the followers’ 
dynamics. 

3. The leader communicates its control action to the fol- 
lowers at each instant of time. 

4. The followers can measure, for example via the Au- 
tonomous Formation Flying sensor (AFF) [5], relative 
distance and velocities to the leader. 


5. The followers have knowledge of their own absolute 
positions, velocities, and angular velocity, and their 
attitude with respect to an inertial frame. 

6. A commanded differential vector with respect to the 
leader, expressed in the inertial frame, is supplied to 
the followers during a particular finite time interval. 

7. Uncertainties, in terms of disturbance forces and 
torques on the follower spacecraft are present. These 
disturbances are causes by solar pressure, gravity gra- 
dient, aerodynamic, or magnetic forces. 

8. Uncertainties, in the spacecraft dynamics model, as 
well as in the communication channel, are considered 
to be negligible. We shall present results pertaining 
to some of these issues in the subsequent papers. 

Under these assumptions, the follower chooses its control 
force and torque based on the knowledge of its own dy- 
namics and the control that was used by the leader to 
track a desired trajectory. We note that relaxing some 
of these assumptions result in a significant change in the 
techniques which can be used to address the formation 
keeping problem. 


3 First, Feedback Linearization 


Under the stated assumptions in §2, we consider the sce- 
nario where the leader’s position, with respect to P 
evolves according to, 


dr 1 , dv 1 

dt ~ V ’ ~df 



The control force f 1 is chosen independent of the followers 
according to some mission objectives, optimality criteria, 
etc. 

Recall that the first and second derivatives of a vector 
^ in F 1 and F* are related by the following relation, 


dA d A . f 
~^ = dT i +u xA > 


(3.1) 


where u l is the angular velocity of F l with respect to F l . 
In particular, 


du' 1 

~dt 


du^ 


W 


X W* = 


du 

"SiT’ 


stating that the rate of change of the angular velocity is 
independent of the frame of reference. 

Differentiating both sides of (3.1) with respect to F 1 we 
obtain, 


d? A __ dr A dui x ja 

W ~ dif + du x A + 2a/ x dT x + * ( w ‘ * ^) ( 3 - 2 ) 


Let, 


r d(0 = r'(t) + t 0 <t<tj-, 


the error is thus, 

«'(0 = r i (0 — r *(<) 

= r ll (t) + h'(t), (3.3) 

where r 11 is the vector from (the origin of) F { to (the origin 
F > *•*•! the position of the leader with respect' to the 
«-th follower spacecraft coordinates. We like to obtain an 
expression which describes the time evolution of e 1 in F l 
From (3.3) one has, 

dV(f) _ d 3 (r“)(<) cPh>(t) 
dt 2 dt 2 + 

however, 

gVIXO _ 

dt 3 dt* 

- '«*(<) - "'(<) (3.4) 

In view of (3.2) we have, 

+M) X (w‘(0 X e l (<)) (3.5) 

= (u 1 (<)-u i (t)) + ^^, (3.6) 

where u 1 represents the total normalized force acting on 
the i-th spacecraft, i.e., 

u ‘(0 = «i (<) + M). 

The last term on the right hand side of (3.6) can of course 
be represented in F l as, 

4 . M<) „ ^ 0 „ 4 , <tt *(0 

dq + ^T (t) + 2u{t)x ~du 

W(t) X (w‘(t) x h‘(f)). (3.7) 

The rate of change of the angular velocity u l with respect 
to F or F is related to the torque applied on the space- 
craft via the Euler’s equation, 


The dynamics of the i-th spacecraft can thus be expressed 
as, 

*l(0 = *2(0. ( 39 x 

i 2 (0 = -2*3(0 x l2 ( 0 -(/ i )- 1 (r c , (0 + r ‘(0 

- * 3(0 X /*X 3 (0) X 1,(0 - x 3 (0 X (x 3 (0 X *i(f)) 

+ (u 1 (0-«‘(0-«i(0) + ^^, (3.10) 

i 3 (o = (/ l r 1 (T-i(o+*i(o-* 3 (Ox/ , * 3 (o). (3.11) 

The differential equations (3.9)-(3.11) describe a nonlin- 
ear dynamical system whose state represents the evolu- 
tion of the position error, position rate error, and the an- 
gular velocity of the follower spacecraft, in the follower’s 
coordinate system. In general, one would like to choose 
the control action such that the error terms go to zero 
while certain optimality conditions, and state and control 
constraints are satisfied. Since designing non-conservative 
optimal nonlinear controllers in their full generality is a 
formidable task, one often restores to less ambitious ob- 
jectives, via for example feedback linearization. 

We notice that the parameters available for the control 
purposes are control force u\ and torque r*. However the 
control torque might be independently used to obtain a 
desired orientation during the maneuver, in which case, 
one would merely focus on obtaining an expression for u* . 

Suppose that the control force and torque are repre- 
seated as, 


“‘w = «i(0 - MO. 

M) = f\t) + rj,(0, 


where, 


Mo •- 2*3(0 X * 2(0 + *3(0 X (* 3 (0 x Xl(t)) 

Mo = * 3 (o x /** 3 (o. 


= (/*)- V(<) -w*(0 X (/*«'(<))) . (3 8) , The Sub ! cri ^ ’ fl ’ aboVe is used to denote the ’feedback 

dU W 1 ( W ^ I ine anzation term. The dynamics is thus simplified to, 


Again the term r 1 represents the total torque on the i-th 
spacecraft, i.e., 

M) = M) + *d(0- 

Now, (3.6) represents how the error vector e 1 evolves in 
F . We would like to obtain an expression for u‘, such 
that the origin is the globally asymptotically stable limit 
point of the trajectories defined by (3.6) in the presence of 
environmental disturbances u l d and r|. For this purpose 
we let, 

*i(0 = e*(0, 

1,(0 = 

*3(0 = w*(<). 


*i(0 = * 2 (0. 

*2(0 = -ui(0-Ud(0 ~(/ , )~ I r^(0 X n(0, 
i 3 (0 = (M^eVO + M)). 

Let T (f ) [*d]- From the statistics of f\ we con- 
struct the set d 

Q C afc 3 * 3 such that T £ Q 

with a probability which can be chosen to be arbitrary 
close to one; now consider the convex hull of fi. For the 
purpose of the present discussion we shall assume that 
the convex hull is a polytope in iK 3 * 3 . Thus, there exists 
matrices T U ...,T,, such that 

reCo{T ll ... f r ,} 1 


where Co denotea the operation of taking the convex hull 
of a set. 

The dynamics of the leader following can thus be rep- 
resented as, 


' ii(0 ' 
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Denote by, 
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Figure 2: The open loop block diagram for the follower 
spacecraft (the plant P represents one of the C, ’s). 


It is known that for an ergodic wide-sense stationary 
stochastic signal, the RMS norm can be expressed in terms 
of the power spectral density function S'(w), 

MOIIrms = Trace — J S w (u)du. 

Now consider the follower spacecraft dynamics after the 
feedback linearization, as represented by (3.13) (Figure 2). 
For each 2} one as a linear time invariant system; let the 
corresponding transfer matrix be denoted by G,(s). The 
RMS gain of a transfer matrix G, or its H x norm is the 
largest ratio of the RMS norm of the noise signal w to the 
RMS norm of the output signal z f i.e., 


and let, 

■«-[$]• “ d "Hf)]' 

The dynamical equations which describe the evolution of 
the follower spacecraft can therefore be summarized as the 
following linear differential inclusion [1], [3], 


IIG.-Wlloo 


sup MMsms . 

II w (0IIrms^° IMOIIrms 


It can also be shown that, 


ll G <‘( 5 )l|oo := sup(j max (Gi(;w)), 

ut 


*(0 = Ax(t) + B u u + B w w(t), (3.14) 

where, 

A€Co{A u ...,A,}. 

The output equation can generically be represented as, 
z(t) = C, x{t) + D, u u(t) + D, w w(t). (3.15) 

In the subsequent section, we shall build on the lineariza- 
tion and the embedding procedure described above to pro- 
pose. a state feedback linear controller for the formation 
keeping problem which attenuates the effects of the dis- 
turbance vector J “f on the state of the follower space- 
craft. 

4 RMS Gain and State Feedback 
Synthesis 


where <r m ax(G,0'w)) denotes the maximum singular value 
of the (complex) matrix Gi(jco) [1], 

We now focus on proposing a state feedback control law 
which has as its goal, the minimization of the RMS gain of 
the resulting family of closed loop feedback systems which 
represent the follower spacecraft dynamics. 

4.1 State Feedback Synthesis 

In this section we present a state feedback control which 
aims to minimize the RMS gain of the family of closed 
loop systems which represent the dynamics of follower 
spacecraft. The follower dynamics with the controller in 
the feedback loop can thus be represented as in Figure 
2, where A is considered to be a constant state feedback 
gain. 

For simplicity of the present discussion, we shall assume 
that D lw = 0, i.e., that the noise does not directly affect 
the output signal r. Let u(t) = Kx(t) in (3.14)-(3.15); 


We model the disturbance vector w(t) := | 

stationary stochastic process having a finite 
defined to be, 



RMS norm, 


IMOIIrms ■'= (Jim 

T—oo 



w(t)'w(t) dt ) l/,J . 


*(0 — (A -)- B u K)x(t) + B w u>(<), 

A € Co {A t ,..., ,4,}, 

-(0 = (C, + D iu K)x(t). 

In order to minimized the RMS gain from w to z, con- 
sider the Lyapunov function V(x ,t) = x(t)'Px(t), where 
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Figure 3: The block diagram for the follower spacecraft 
with the state feedback controller (the plant P represents 
one of the (7, ’s). 

the matrix P is positive definite. Suppose that P is cho- 
sen such that there exists a nonnegative number y satis- 
fying [1], 

V ( x > 9 + *(<)'*(<) ~ 7 3 w(t)'w(t) < 0. (4. 16) 

Thereby, 

■ - r 

_im — / 

T- 



■ • 10 


Figure 4: Simulation results for a representative scenario 


iSa, 

1 f T 

- t ] ™tJ 0 tMOXO* < o, 

since V(x(T)) > 0. Thus one can deduce that, 

II z (01Irms 


Thus, in order to find a controller which aims to minimize 
the RMS gain of the family of closed loop systems rep- 
resenting the follower spacecraft dynamics, we are led to 
solve the following semi-definite program, 

min^y q y 

Q> o, 

I AiQ + QA i + B » Y + Y'BJ + B W BJ (CzQ + D mu YY 
L ( C,Q + D lu )Y 


~7 2 I 


(i= 1, 


II^COIIrms 


<7, 


i.e., one can bound the RMS gain of the closed loop sys- 
tem by A by an appropriate selection K which admits a 
quadratic Lyapunov function with the desired properties. 

Expanding the condition (4.16) for the family of transfer 
matrices <?,•’ s (i = 1, . . . , /), one obtains, 

{Ax(t) + B u u(t) + B w w(t))'Px(t) 
+x(t)'P(Ax(t) + B u u(t) + B w w(t)) 

~( C • *(0 + D, u u(t) + D, w w(t))'(Cz x(t) 

+Dju «(0 + Dz W w(t)) — j 2 w(t)'w(t) < 0, (417) 

for all /l 6 Co , . . . A,} and all r e ft 9 . 

After some simplifications, and setting Q := P~ l t and 
Y = KQ (4.17) can be written as, 


[S S]-<» 

0 = 1 /), 


and then let K = VQ- 1 . 

5 An Example 

In this section we provide an example and the correspond- 
ing simulation result for the proposed state feedback syn- 
thesis procedure discussed above. For this purpose, given 
the matrices A x , . . . , Ai, B u , and B w , as in (3. 14), we chose 
the following matrices for the simulation purposes, 

C, = / and D lu = 0. 

The LMItool, an optimization package developed by El 
Ghaoui, Nikoukhah, and Delebercque based on the SP 
code of Boyd and Vandenberghe, implementing the pri- 
mal/dual interior point method for solving semi-definite 
programs, was used to solve the SDP (4.18)-(4.18). The 
disturbance force and torque was modeled as a band lim- 
ited white noise. The simulation result is depicted in Fig- 
ure 3. 


where, 


-Y u = + QA[ + B U Y + Y'BJ + B W B W \ 

X 2i=(C t Q + D MU YY, 
X 3i = - 7 3 /. 


6 Conclusion 

We proposed a disturbance rejection mechanism for the 
formation keeping problem. The disturbance rejection 
problem is first formulated in terms of a family of 
optimization problems. We then proceeded to solve these 




//«, problem using their LMI formulations via the recently 
proposed interior point methods. A numerical example 
was provided to demonstrate the usefulness of the pro- 
appr °ach for formation flying in the presence of 
rCMb bounded disturbance forces and torques. 
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